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Abstract-This  paper  provides  an  overview  of 
the  Naval  Postgraduate  School  ARIES 
autonomous  underwater  vehicle  and  its 
guidance,  navigation  and  control 
performance.  An  attempt  is  made  to  highlight 
its  current  operational  capabilities  and 
provide  a  description  of  future  enhancements 
for  greater  mission  utility  and  flexibility.  An 
overview  of  the  vehicle  design  along  with 
descriptions  of  all  major  hardware 
components  and  sensors  is  given.  A  major 
discussion  of  the  implementation  of  a 
modular,  multi-rate,  multi-process  software 
architecture  for  ARIES  autonomous  control  is 
provided.  The  architecture  is  designed  to 
operate  using  either  a  single  computer 
processor  or  two  independent,  cooperating 
processors  linked  through  a  network  interface 
for  improved  load  balancing.  A  dual 
computer  implementation  is  presented  here 
since  each  processor  assumes  different  tasks 
for  mission  operation.  Also  included  is  a 
section  on  the  underwater  navigation  method 
using  a  real-time  extended  Kalman  filter  that 
fuses  all  sensor  data  and  computes  the  real 
time  position,  orientation,  velocity,  etc.,  of  the 
vehicle.  Experimental  results  for  navigational 
accuracy  using  a  DGPS  /  IMU  /  Doppler  aided 
navigation  system  are  presented  with  DGPS 
pop-up  maneuvers. 

I.  INTRODUCTION 

The  use  of  AUVs  for  Ocean  Survey  and 
military  mine  countermeasures  is  well 
documented  (Curtin  et.  al.,  1993,  Smith  et. 
al.,  1998,  and  Allen,  et.  al.,  97,  among  many 
others).  The  continuing  problems  facing  further 


commercial  use  of  such  systems  include  accurate 
underwater  navigation  and  communications 
links.  Further  research  in  low  cost  navigational 
accuracy  and  communications  links  is  needed 
and  toward  that  end,  this  paper  presents  a 
description  of  the  latest  generation  of  NPS 
underwater  vehicle  named  the  ARIES  AUV.  The 
ARIES  vehicle  is  a  shallow  water 
communications  server  vehicle  with  a  DGPS 
Doppler  aided  IMU  /  Compass  navigation  suite. 
Navigational  errors  are  corrected  by  DGPS  when 
surfaced,  which,  for  shallow  water  applications 
presents  no  penalty.  The  vehicle  is  shown  in  a 
DGPS  pop-up  maneuver  in  Monterey  Bay  in 
Figure  1,  and  Figure  2  shows  the  component 
layout  of  the  vehicle.  The  hull  was  outfitted  in 
the  fall  of  1999  and  has  recently  become  fully 
operational  (Spring  2000).  The  vehicle  has  been 
designed  as  a  network  server  platform/target 
reacquisition  vehicle,  and  has  been  operated 
during  AUVFest  ’99  in  Gulfport,  MS  (AUVFest 
‘99). 


Figure  1.  The  NPS  ARIES  AUV  in  a  GPS  Pop¬ 
up  Maneuver  (December  2000) 
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H.  VEHICLE  DESCRIPTION 

Descriptions  of  the  major  hardware 
components  of  the  ARIES  shown  in  Figure  2,  are 
given  below. 

Dimensions  and  Endurance:  The  vehicle 
weighs  225  Kg  and  measures  approximately  3  m 
long,  0.4  m  wide  and  0.25  m  high.  The  hull  is 
constructed  of  *4”  thick  6061  aluminum  and 
forms  the  main  pressure  vessel  that  houses  all 
electronics,  computers,  and  batteries.  A  flooded 
fiberglass  nose  is  used  to  house  the  external 
sensors  and  power  on/off  switches  and  status 
indicators.  It  is  capable  of  a  top  speed  of  3.5 
knots  and  is  powered  by  six  12  volt  rechargeable 
lead  acid  batteries.  The  endurance  is 
approximately  4  hours  at  top  speed,  20  hours 
hotel  load  only.  The  ARIES  was  primarily 
designed  for  shallow  water  operations  and  can 
operate  safely  down  to  30  meters.  However,  with 
hull  strengthening  in  certain  areas,  a  depth  of  100 
meters  may  be  attained. 

Propulsion  and  Motion  Control  Systems: 

Main  propulsion  is  achieved  using  twin  Vi  Hp 
electric  drive  thrusters  located  at  the  stem. 
During  normal  flight,  heading  and  depth  is 
controlled  using  upper  bow  and  stem  rudders 
and  a  set  of  bow  planes  and  stem  planes.  Since 
the  control  fins  are  ineffective  during  very  slow 
or  zero  forward  speed  maneuvers,  vertical  and 
lateral  cross-body  thrusters  are  to  be  used  to 
control  surge,  sway,  heave,  pitch,  and  yaw, 
motions. 

Navigation  Sensors:  The  sensor  suite  used  for 
navigation  includes  a  1200  kHz  RD  Instruments 
Navigator  DVL  that  also  contains  a  TCM2 
magnetic  compass.  This  instrument  measures  the 
vehicle  ground  speed,  altitude,  and  magnetic 
heading.  Angular  rates  and  accelerations  are 
measured  using  a  Systran  Donner  3-axis  Motion 
Pak  IMU  that  is  considered  to  be  a  low  cost 
"Tactical"  grade  IMU.  While  surfaced,  carrier 
phase  differential  GPS  (DGPS  CP)  is  available 
to  correct  any  navigational  errors  accumulated 
during  the  submerged  phases  of  a  mission.  In 


addition,  and  because  of  inaccuracies  in  the 
TCM2  compass,  a  Honeywell  HMR3000 
magneto-restrictive  compass,  corrected  by  a 
deviation  table,  is  used  as  the  primary  heading 
reference  standard. 
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Figure  2.  Hardware  Components  of  the  NPS 
ARIES 

Sonar  and  Video  Sensors:  A  Tritech  ST725 
scanning  sonar  or  an  ST 1000  profiling  sonar  is 
used  for  obstacle  avoidance  and  target 
acquisition/reacquisition.  The  sonar  heads  can 

O 

scan  continuously  through  360  of  rotation  or 
swept  through  a  defined  angular  sector.  A  fixed 
focus  wide-angle  video  camera  (Deep  Sea  Power 
and  Light  -  SSI 00)  is  located  in  the  nose  and 
connected  to  a  DV  recorder.  The  computer  is 
interfaced  to  the  recorder  and  controls  on/off  and 
start/stop  record  functions.  While  recording,  the 
date,  time,  vehicle  position,  depth  and  altitude  is 
superimposed  on  the  video  image. 
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Vehicle/Operator  Communications:  Radio 
Modems  are  used  for  moderate  bandwidth 
command,  control  (300  bytes/sec  over  4  nm. 
with  repeaters),  and  system  monitoring  while  the 
vehicle  is  deployed  and  surfaced.  While 
submerged,  an  acoustic  modem  will  be  used  for 
low  bandwidth  communications.  In  the 
laboratory  environment,  a  high-speed  thin- wire 
ethernet  connection  is  used  for  software 
development  and  mission  data  upload/download. 

III.  COMPUTER  HARDWARE 

ARCHITECTURE 

The  dual  computer  system  unit  consists  of  two 
Ampro  Little  Board  166  MHz  Pentium 
computers  with  64  MB  RAM,  four  serial  ports,  a 
network  adapter,  and  a  2.5  GB  hard  drive  each. 
Two  DC/DC  voltage  converters  for  powering 
both  computer  systems  and  peripherals  are 
integrated  into  the  computer  package.  The  entire 
computer  system  draws  a  nominal  48  Watts. 
Both  systems  use  TCP/IP  sockets  over  'thin- wire' 
ethemet  for  inter  processor  communications  and 
connections  to  an  external  LAN.  The  sensor  data 
gathering  computer  is  designated  QNXT,  while 
the  second  is  named  QNXE  and  executes  the 
various  auto-pilots  for  servo  level  control.  Both 
computers  are  used  as  the  baseboard  for  a  stack 
of  Diamond  Systems  PC- 104  data  acquisition 
boards. 

IV.  COMPUTER  SOFTWARE 

ARCHITECTURE 

A.  The  Architecture 

A  diagram  outlining  the  modular,  multi-rate, 
multi-process  software  architecture  is  shown  in 
Figure  3.  The  architecture  is  designed  to  operate 
using  a  single  computer  processor  or  two, 
independent,  co-operating  processors  linked 
through  a  network  interface.  Splitting  the 
processing  between  two  computers  can 
significantly  improve  computational  load 


balancing  and  software  segregation.  A  dual 
computer  implementation  will  be  presented  here, 
since  in  the  ARIES,  each  processor  assumes 
different  tasks  for  mission  operation.  Both 
computers  run  the  QNX  real  time  operating 
system  using  synchronous  socket  sender  and 
receiver  network  processes  for  data  sharing 
between  the  two.  Inter-process  communication  is 
achieved  using  semaphore  controlled  shared 
memory  structures.  At  boot  time,  the  network 
processes  are  started  automatically  and  all  shared 
memory  segments  are  created  in  order  to 
minimize  the  amount  of  manual  setup  performed 
by  the  user. 

All  vehicle  sensors  are  interrogated  by 
separate,  independently  controlled,  concurrent 
processes,  and  there  is  no  restriction  on  whether 
the  processes  operate  synchronously  or 
asynchronously.  Since  various  sensors  gather 
data  at  different  rates,  each  process  may  be 
tailored  to  operate  at  the  acquisition  speed  of  the 
respective  sensor.  Each  process  may  be  started, 
stopped,  or  reset  independently  allowing  easy 
reconfiguration  of  the  sensor  suite  needed  for  a 
given  mission.  All  processes  are  written  in  C. 

To  allow  synchronous  sensor  fusion,  each 
process  contains  a  unique  shared  memory  data 
structure  that  is  updated  at  the  specific  rate  of 
each  sensor.  All  sensor  data  are  accessible  to  a 
synchronous  navigation  process  through  shared 
memory  and  is  a  main  feature  of  the  software 
architecture.  Incorporated  into  the  navigation 
process  is  an  extended  Kalman  filter  that  fuses 
all  sensor  data  and  computes  the  real  time 
position,  orientation,  velocity,  etc.,  of  the 
vehicle.  The  dual  computer  implementation  uses 
one  processor  for  data  gathering  and  running  the 
navigation  filters,  while  the  second  uses  the 
output  from  the  filters  to  operate  the  various 
auto-pilots  for  servo  level  control.  Once  the  state 
information  is  computed,  it  is  transmitted  to  the 
second  computer  over  standard  TCP/IP  sockets. 


3 


SHUTDOWN 

B.  Mission  Control  Modes 


All  vehicle  behaviors  are  determined  by  a  pre¬ 
programmed  mission  script  file.  This  is  parsed  in 
the  QNXE  computer  by  the  process  Exec.  The 
file  contains  a  sequential  list  of  commands  that 
vehicle  is  to  follow  during  a  mission.  These 
commands  may  be  as  simple  as  setting  the  stem 
propulsion  thruster  speeds  to  more  complex 
maneuvers  such  as  commanding  the  vehicle  to 
repeatedly  fly  over  a  submerged  target  at  a  given 
GPS  coordinate  using  altitude  and  cross  track 
error  control. 


This  commands  the  vehicle  to  fly  above  the 
bottom  at  an  altitude  of  2  meters  with  a  heading 
of  60  degrees,  while  running  the  twin  stem 
thrusters  at  700  rpm.  The  run  is  designed  to  last 
for  a  total  of  300  seconds.  The  above  mission 
could  also  have  used  depth  instead  of  altitude 
control  by  simply  replacing  SET_ALTITUDE 
with  SET_DEPTH  and 

USE_ALTITUDE_CONTROL  with 

USE_DEPTH_CONTROL. 

V.ARIES  AUTOPILOT  CONTROL  LAWS 


Below  is  an  example  of  a  simple  mission  script 
file. 


SET_ALTITUDE  2.0 _ 

SET_HEADIN G  60.0 _ 

SET,  S TERN_THRU S TER_S PEED  700.0 
USE_ALTITUDE_CONTROL _ 

USE,  HEADING_CONTROL _ 

USE_STERN_THRUSTER_SPEED_CONTROL 
SET_FLIGHT_DURATION  300.0 


The  NPS  ARIES  currently  uses  four  different 
autopilots  for  flight  maneuvering  control.  They 
consist  of  independent  diving,  steering,  altitude 
above  bottom,  and  cross-track  error  controllers. 
All  four  autopilots  are  based  on  sliding  mode 
control  theory  and  each  mode  (i.e.  diving, 
steering)  is  decoupled  for  ease  of  implementation 
and  design.  A  reference  for  the  details  of 
controller  design  methodology  may  be  found  in 
(Healey  and  Lienard,  1993).  These  control  laws 
are  not  unique,  for  example,  fuzzy  and  heuristic 
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control  is  used  in  the  FAU  vehicles  (An,  et.  al., 
1997).  However,  the  authors  here  have  found 
that  Sliding  Mode  controllers  are  simple  to  use 
and  implement  with  minimal  tuning. 

A.  Depth  Controller 

Since  the  vehicle  depth  can  be  independently 
controlled  by  the  dive  planes  alone,  the  diving 
controller  may  be  modeled  by  a  linearized 
system  with  a  single  generalized  input  control, 
u(t),  generating  a  pitch-dive  control  distributed  to 
bow  and  stem  planes  in  an  equal  and  opposite 
amount,  and  is  of  the  form 

x  =  Ax  +  bu,  (1) 


and  for  the  ARIES,  the  dynamics  are  given  by 
the  system  of  equations 


<7(0' 

'-1.3899 

-0.0032 

O' 

9(0 

'-2.6091' 

6(0 

= 

1 

0 

0 

6(0 

+ 

0 

5  sp  (t)  +  ( disturbances ) 

m 

0 

-U 

0 

Z(0 

0 

(2) 


where  q(t)  is  the  pitch  rate,  9 (/)  is  the  pitch 
angle,  Z(t )  is  the  depth  in  meters,  and  5  (t)  is 

the  stem  plane  angle  in  radians.  U  is  the  nominal 
longitudinal  speed  of  the  vehicle  expressed  in 
(m/sec)  and  a  value  of  1.8  m/sec  is  used. 
Although  the  bow  and  stem  planes  may  be 
independently  controlled,  currently  both  sets  of 
planes  operate  as  coupled  pairs  such  that  the 
command  to  the  bow  planes  is  —8 At).  Notice 

that  the  heave  velocity,  w,  equation  is  ignored,  as 
also  are  its  effects  on  the  q  and  Z  equations  of 
motion.  They  are  considered  to  be  disturbances. 
The  reduction  of  the  system  to  third  order  creates 
a  simplification  that  is  both  valid  and  useful. 

The  sliding  surface  is  then  formed  as  a  linear 
combination  of  state  variable  errors  in  the  usual 
way.  Ignoring  any  nonzero  pitch  angle  and  rate 
commands,  the  sliding  surface  polynomial 
becomes 

op)  =  0.7693q{t)  +  (J.6385e(t)  +  0.072488(Zcom  -  Z(t )) 

(3) 


and  the  corresponding  control  law  for  the  stern 
planes  is 

ci  jt)  =  0.4994(  -0.4105q{t)  +  0.1086e{t)  +  gtanUaif)  /(|>) 

(4) 

where  r \=1.0  and  §  =0.5  . 

B.  Altitude  Controller 

In  order  to  control  the  vehicle  altitude  above 
the  bottom  designated  h(t),  we  simply  need  to 
change  some  of  the  signs  of  the  terms  from  the 
diving  equations.  Noting  the  sign  difference  of 
the  pitch  angle  and  rate  coefficients,  this  results 
in  the  following  sliding  surface 

<5(0  =  - 0.7693q(t )  -  0.6385e(t)  +  0.0724(hcom  -  h(t ))  • 

(5) 

The  stern  plane  command  for  altitude  control  is 

8jt)  =  -0.4994(0.4105^(0  -  0.10860(1)  +  T|  tanh (o (!)/<])» 

(6) 

where  r \=1.0  ,  §  =0.5  ,  and  hit)  in  meters 
replaces  the  vehicle  depth,  Z. 

C.  Heading  Controller 

By  similar  reasoning,  and  to  eliminate  the 
need  to  feedback  the  sideslip  velocity,  we  argue 
that  a  second  order  model  is  sufficient.  The  side¬ 
slip  effects  are  treated  as  disturbances  that  the 
control  overcomes.  Thus  the  heading  model 
becomes 

r{t)  =  ar(t)  +  bb  r(t)  +  {disturbances)  ^ 
V(0  =  K0 

where  r(t)  is  the  yaw  rate  and  8  (/)  is  the  stern 
rudder  angle.  The  coefficients  a  and  b  have 
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been  determined  using  system  identification 
techniques  from  past  in  water  experiments  and 
are  a  =  -0.30  rad/sec  and 

b  =  -  0.1125  rad/sec2 .  The  stern  and  bow 
rudders  operate  in  the  same  way  as  the  planes 
therefore,  the  command  to  the  bow  rudder  is 
-8,  (0  . 

Notice  that  in  order  to  use  this  steering  law, 
(VOTm  -V)  must  8e  between  ± 180 °,  and  is  de- 
wrapped  as  needed  in  order  to  make  that  happen, 
and  ignoring  any  nonzero  command  yaw  rate, 
the  sliding  surface  is  defined  by 

a(t)  =  -  0.9499  r(t)  +  0.1 701(\\icom  -y  (f)) . 

(8) 

The  stern  rudder  command  for  heading  control  is 

8  r  (t)  =  - 1.543(2.3394 r(t)  +  gtanhiG  (t)k )>)) 

(9) 


where  r\  =  1.0  and  §=0.5 . 


D.  Cross  Track  Error  Controller 

To  follow  a  set  of  straight  line  tracks  that 
form  the  basis  of  many  guidance  requirements,  a 
sliding  mode  controller  is  presented  that  has 
been  experimentally  validated  under  a  wide 
variety  of  conditions.  Other  works  have  studied 
this  problem  for  land  robots,  (for  example, 
Kanayama,  1990)  and  usually  develop  a  stable 
guidance  law  based  on  cross  track  error.  Here, 
with  Figure  4  as  a  guide  to  the  definitions,  we 
use  a  combination  of  a  line  of  sight  guidance 
(Healey,  Lienard,  1993)  and  a  cross  track  error 
control  for  situations  where  the  vehicle  to  track 
heading  error  is  less  than  40  degrees.  For  the  line 
of  sight  guidance  with  large  heading  error,  a 
separate  line  of  sight  controller  is  used. 

One  of  the  shortcomings  of  the  heading 
controller  defined  above,  is  that  it  has  no  ability 
to  track  a  straight  line  path  between  two  way 
points,  since  it  can  only  regulate  the  vehicle 


heading.  It  is  desired  to  command  the  vehicle  to 
track  a  line  between  two  way-points  with  both  a 
minimum  of  error  from  the  track  and  heading 
error  between  the  vehicle  and  the  track.  This  type 
of  regulation  is  known  as  cross  track  error 
control  and  the  variable  definitions  are  illustrated 
in  Figure  4. 


Figure  4.  Cross  Track  Error  Definitions 

The  variable  of  interest  to  minimize  is  the  cross 
track  error,  e(t),  and  is  defined  as  the 
perpendicular  distance  between  the  center  of  the 
vehicle  (located  at  (X(t),Y(t))  and  the  adjacent 
track  line.  The  total  track  length  between  way 
point  i  and  i-1  is  given  by 


A  =  s(X 


"  wpt( i ) 


xwpt(i^y  +  (a 


wpt(  i ) 


Y, 


wpt(  i—1 )  ' 

(10) 


where  the  ordered  pairs  (Xwpt(i),  Ywpt(i))  and 
( YwPt(i-i)>  Xwpta_, , )  are  the  current  and  previous 
way  points  respectively.  The  track  angle,  \| \f  trk(i) , 
is  defined  by 


¥ 


trk(i) 


tan  2  (Ywpt(i)  Ywpt(i_1)t  X  wpt(i)  Xwpt(i_1}/ 

(11) 


The  cross  track  heading  error  ¥(0cwo  f°r  the 
i,h  segment  is  defined  as 
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V(t)CTFM>  =V(0  -VtHi) 


(12) 


where  vj/(l)cmo  must  be  normalized  to  lie 

between  ±180°.  The  difference  between  the 
current  vehicle  position  and  the  next  way  point  is 


The  sliding  surface  for  the  cross  track  error 
controller  becomes  a  second  order  polynomial  of 
the  form 


a(0=e(0  +  M(0  +  ^e(0  (17) 


X(t)wpm  =  Xwpt(i)  -  X(t) 
Y{t)wpt(i)  =  Ywpt(i)  -  7(1) 


(13) 


The  condition  for  stability  of  the  sliding  mode 
controller  is 


With  the  above  definitions,  the  distance  to  the  ith 
way  point  projected  to  the  track  line  S(t)i ,  can 
be  calculated  using 

S(t),  =  X(t)  wpt(i)  ~Xwl „(!_!))  +  Y  (t)wplOf  Cwpt(i)  ~  Ypl(i-I))^i 

(14) 

therefore,  S(t)i  ranges  from  0-100%  of  L  . 


d  (1)  =  £  it)  +  kj£(t)  +  X2e  (0  =  -T|  (cj/c(> ) ,  (18) 

and  to  recover  the  input  for  control,  the  heading 
dynamics  Equation  (7)  may  be  substituted  into 
Equation  (16)  to  obtain 

U(ar(t)  +  65,)cos(\|/(f)CIE(0)  -  Ur(tf  sin(y  (0cr£(i))  +  ... 
\C/f(0cos(V|/(0cr£(i,)+  XJJ  sin(\|/(f)CJS(i)) 

Rewriting  Equation  (15),  the  sliding  surface 
becomes 


The  cross  track  error  8(1)  may  now  be  defined  as 
8(1)  =  S,(t)sin(ap(t))  (15) 

where  ap  (1)  is  the  angle  between  the  line  of 

sight  to  the  next  way  point  and  the  current  track 
line  given  by 

dp  (0  ~  tan  ^  (YWpt(i )  ~  Y wpt(i-l )  ’  X wpt(i )  ~  Xwpt(j-i )  ) 

-  tan  2'1  (Y (t)wpt(i)  -  X{t)wpt(i)) 

(16) 

and  must  be  normalized  to  lie  between  ±  180° . 

With  the  cross  track  error  defined,  the  sliding 
surface  can  be  cast  in  terms  of  derivatives  of  the 
errors  such  that 
8(1)  =8(1) 

8(1)  =6/  sin(y(t)CTFM) ) 

8(1)  =  0(1)  cos  (tj7  (t)CTF(l) ) 

8(1)  =  0(1) co5(tfi (t)CTF(i) ) - 0(1)-  sin(tf (t)CTF(ij ) 


o  (1)  =  U r(t)  co s{p  (t)CTE(i))  +  X,U  sin(0  (t)crE(i))  +  M( 

(20) 


The  rudder  input  can  be  expressed  as 


8,(1)  = 


l 


Ub  cosio  it) CTE(i) ) 


\-Uar(t)  cosio  (t)CTE(i)) 


+  (7(r(l))-  sinio  (t)CTFIi))  -  X,Urit)  cosio  (t)cmi)  ) 
-  XU  sinio  it)CTEU) )  -  f  (a  (t)l§ )) 

(21) 


where  XI  =  0.6,  X2  =  0.1,  r)  =  0.1,  and 
(f>  =  0.5 .  To  avoid  division  by  zero,  in  the  rare 
case  where  cosio  (J)CTF  )  =  0.0  (i.c.  the  vehicle 
heading  is  perpendicular  to  the  track  line)  the 
rudder  command  is  set  to  zero  since  this 
condition  is  transient  in  nature. 


Line  of  Sight  Controller 

When  the  condition  arises  that  the  magnitude 
of  the  cross  track  heading  error  \o  (l)cr£.(0| 
exceeds  40°,  a  Line  of  Sight  Control  (LOS)  is 
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used.  In  this  situation,  the  heading  command  can 
be  determined  from 


V(0Com(LOS)  tan  2  (¥  (t)wpt(i)>X(f)wpt(i) ) 

(22) 

and  the  LOS  error  from 

V  (0 LOS  =V  ( 0com(LOS )  ~  V  (0  >  (23) 

and  the  control  laws  used  for  heading  control. 
Equations  (8,9)  may  be  used. 

Two  conditions  may  be  true  for  the  way  point 
index  to  be  incremented.  The  first  and  most 
usual  case  is  if  the  vehicle  has  penetrated  the 
way  point  watch  radius  Rw(i) .  Secondly  if  a  large 

amount  of  cross  track  error  is  present,  the  next 
way  point  will  become  active  if  the  projected 
distance  to  the  way  point  S{t)t  reached  some 

minimum  value  Smiri(i) ,  such  that 


if  *  K(l)  II  S(t),  <  SV.J  THEN 

Activate  Next  Way  Point 

In  water  experimental  results  using  the 
controllers  presented  above  will  now  be 
presented  in  the  next  section. 

VI.  NAVIGATION 

The  ARIES  vehicle  uses  an  INS  /  DOPPLER 
/  DGPS  navigational  suite  and  an  Extended 
Kalman  Filter  (EKE)  which  was  developed  and 
presented  in  (Healey,  An,  Marco,  1998),  and 
may  be  tuned  for  optimal  performance  given  a 
set  of  data.  The  main  impediments  to 
navigational  accuracy  are  the  heading  reference 
and  the  speed  over  ground  measurement.  In  this 
system,  the  heading  reference  is  derived  from 
both  the  Honeywell  compass  and  the  Systran 
Donner  IMU,  which  provides  yaw  rate.  The 
fusion  of  the  yaw  rate  and  the  compass  data  leads 
to  an  identification  of  the  yaw  rate  bias,  which  is 
assumed  to  be  a  constant  value.  The  compass 
bias  which  is  mostly  dependent  on  vehicle 
heading  relative  to  magnetic  north  (An,  1997)  is 
identified  in  the  EKF  (Healey,  An,  1998) 


(Grenon,  2001)  using  DGPS  positions  when 
surfaced.  When  submerged,  the  position  error 
covariance  grows,  but  is  corrected  on  surfacing. 
A  relatively  short  surface  time,  (for  example,  10 
seconds)  allows  the  filter  to  re-estimate  biases, 
correct  position  estimates  and  continue  with 
improved  accuracy.  As  a  demonstration,  the 
ARIES  vehicle  was  operated  in  Monterey  Bay, 
in  a  series  of  runs  including  a  dive-surface-dive- 
surface  sequence.  Figure  5,  below  shows  a  plot 
of  vehicle  position  in  an  exercise  where  the 
vehicle  is  commanded  to  follow  a  track  at  depth, 
come  up  for  a  DGPS  correction,  then  follow  the 
bottom  at  an  altitude  of  3m,  while  a  video  is 
recorded  from  a  down-looking  camera.  The 
vehicle  then  surfaces  to  get  a  second  fix  before 
turning  round  and  repeating  the  exercise  from  the 
complementary  heading.  In  this  plot,  the  vehicle 
trajectory  is  designed  to  fly  over  the  Monterey 
Inner  Shelf  Observatory  (MISO)  Instrument 
Frame  placed  in  12  meters  of  water 
approximately  0.5  kilometers  from  shore  with 
estimated  GPS  position  used  to  design  the 
approach  lane.  The  video  taken  as  the  vehicle 
flies  over  the  MISO  is  designed  to  provide 
identification  details  of  the  arbitrary  object  given 
its  approximate  DGPS  location  point. 


VEHICLE  PATH 


Figure  5  a.  Vehicle  Path  showing  locations  where  the  GPS 
position  fixes  were  obtained  by  surfacing  for  20  seconds 
(asterisks).  5b.  Depth  response  during  run  that  clearly 
shows  the  DGPS  pop  up  maneuvers. 


In  Figure  6,  a  close  up  of  the  final  surfacing 
maneuver  shows  that  there  is  great  consistency  in 
estimating  the  true  DGPS  data  point  as  seen  by 
the  AshTec  G-12  unit  on  board.  The  difference 
between  the  Kalman  Filter  solution  and  the 
DGPS  data  points  while  surfaced  is  sub  meter 
precision.  However,  the  difference  between  the 
dead  reckoning  solution  underwater  is  a  few 
meters  off  the  mark. 

In  Figure  7,  the  number  of  visible  satellite 
vehicles  seen  by  the  DGPS  unit  are  shown  to 
evolve  quickly.  Within  10  seconds,  9  satellites 
are  being  used  to  compute  the  position  solution. 


Figure  7.  Time  history  of  the  Response  of  the  Number  of 
Visible  GPS  Satellites  during  the 
Surface  phase  shown  in  Figure  6. 


VEHICLE  PATH 
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Figure  6.  Close  up  of  the  Final  Surface  Showing  the  Filter 
Solution  together  with  the  DGPS  Measurement  At  the 
Surface. 


Figure  8.  Compass  Bias  Estimate  versus  time. 
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Figure  8  shows  the  response  of  the  heading  bias 
estimate  from  the  EKF  for  the  entire  run.  At  each 
surface  approximately  10  DGPS  points  are 
obtained  which  rapidly  corrects  the  compass 
bias.  However,  as  is  seen,  compass  corrections  in 
the  neighborhood  of  5  degrees  are  still  needed  to 
predict  correctly  the  vehicle  positions.  This  is  an 
indication  that  further  corrections  of  the  compass 
deviation  table  are  needed.  The  remaining 
question  is  whether  or  not  the  deviations  are 
predictable  or  random.  While  some  additional 
runs  suggest  that  there  may  be  some  degree  of 
consistency,  it  remains  to  be  shown  conclusively. 

In  spite  of  the  above,  the  navigation  accuracy 
was  sufficient  to  identify  using  video  the  MISO 
Laboratory  4  times  out  of  5  passes.  The  photo  in 
Figure  9  shows  an  image  of  the  structure  from  3 
m  above  bottom. 


operations  where  the  ARIES  communicates 
through  an  aerial  relay  to  act  as  a  command  and 
control  server  for  other  vehicles.  Its  acoustic 
modem  would  be  used  with  multiple  worker 
vehicles  that  are  engaged  in  a  search  pattern. 
Figure  9  below  shows  the  ARIES  on  the  surface 
using  a  radio  modem  to  report  mission  status  of 
the  worker  vehicles  (possibly  vehicle  positions, 
image  snippets  of  targets,  and  hydrographic  data) 
to  the  command  ship.  Navy  assets  in  mine 
hunting  use  the  MEDAL  software  system  as  a 
common  operating  environment  for  the  viewing 
of  asset  positions,  contact  reports  and 
bathymetry  data. 


CONCEPT  OF  OPERATION  FBE-INDIA 


ARIES  AUV/UAV  IMAGE 
TRANSFER 
DEMONSTRATION 


Figure  9.  Sever  vehicle  concept.  Low  bandwidth 
i  ubmerged  data  transfer  between  underwater 
vehicles.  High-speed  radio  data  relay  to  and  from 
command  ship. 
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Figure  9  Photo  of  MISO  frame  structure  from  3  m  above 
bottom  in  12  m  Water  Depth 


VIII.  CONCLUSIONS 


VII.  SERVER  VEHICLE  CONCEPT 

It  is  proposed  to  use  the  NPS  ARIES  as  a 
network  communications  and  navigation  server 
vehicle  for  multi- vehicle  cooperative  operations. 
One  of  the  needs  is  underwater  data  transfer 
between  network  nodes  through  noisy 
communication  channels.  Use  of  the  server 
vehicle  as  a  data  relay  increases  the  range  of 
communications  of  the  underwater  components 
of  the  network.  Figure  9  describes  the  concept  of 


This  paper  has  described  a  third  generation 
AUV  from  the  NPS  Center  for  AUV  Research. 
A  new  computer  architecture  has  been  described 
to  enable  the  vehicle  to  operate  as  a  network 
server  using  acoustic  and  radio  communication 
hnks.  Most  importantly,  the  vehicle  has  been 
designed  for  accurate  navigation  in  shallow 
water  using  an  extended  Kalman  filter  and 
DGPS -CP.  In  spite  of  many  efforts  to  generate 
an  accurate  compass  deviation  table  with  less 
than  one  degree  of  error,  heading  errors  larger 
than  this,  appear  to  remain.  Position  errors  less 
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than  5  meters  can  be  found  using  a  second  DGPS 
correction  in  most  cases.  To  obtain  position 
errors  within  1  meter,  extreme  care  in  developing 
the  compass  deviation  table  must  be  taken.  In  the 
future  to  get  errors  within  1  %  of  distance 
traveled  will  require  a  high  quality,  high  cost, 
navigation  grade  IMU.  The  results  have  shown 
that  the  control  errors  are  very  small  and  all 
controllers  are  well  behaved  and  8  to  9  GPS 
satellites  can  be  acquired  with  10  seconds  of 
surfacing.  Research  is  ongoing  in  the  field  of 
multi- vehicle  cooperative  behavior  and  common 
control  languages. 
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